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ABSTRACT 


This  papar  axaainas  the  problems  of  stata 
asfciaatioo  for  a  moving  acoustic  sourca  confined  to 
a  well-defined,  simply-connected  or  multiply- 
connectad  ragioa  of  stata  spaca.  A  aultlpla- 
paramatar  constrained  estimator  that  provides 
enhanced  performance  and  that  permits  determina¬ 
tion  of  tha  most  probable  solution  is  presented. 

Tha  astiswtor  is  a  batch  processor  that  yields  both 
dynamic  and  residual  classifiers,  tha  behavior  of 
which  is  shown  to  ba  dependant  on  sourca-obsorvar 
geometry.  Tha  proposed  realization  is  well-suited 
for  solution  salaction  through  hypothesis  tasting. 
Experimental  results  showing  estimator  performance 
are  presented  and  solution  quality  la  discussed. 


I.  INTRODUCTION 


In  the  underwater  environment  there  are 
numerous  situations  in  which  a  source  is  known  to 
be  confined  to  one  of  several,  well-defined  regions 
of  tha  stata  space.  Effective  state  estimation 
under  these  conditions  requires  that  maximum  use  be 
made  of  all  available  information,  and  that  some 
awasure  of  solution  quality  ba  provided.  Speci¬ 
fically,  constraints  on  the  state  space  environment 
are  critical  for  problems  charaetarixad  by  large 
raage-to-baseline  ratios  or  high  levels  of 
measurement  noise.  Previous  work  has  dssnnstratad 
that  for  the  case  where  only  bearing  measurements 
involving  high  levels  of  "effective  noise"  are 
available,  a  phenomenon  is  experienced  whereby 
significant  deterioration  in  performance  occurs 
with  increasing  range  or  noise  level. That 
study  also  examined  estimation  under  a  speed  con¬ 
straint  and  demonstrated  significant  improvement 
when  such  a  priori  information  was  included.  Often, 
additional  known  parameters  or  knowledge  of  the 
physical  constraints  on  some  function  of  the  source 
state  components  (such  as  a  bound  on  range,  speed, 
or  depth)  are  available  and  should  be  exploited. 


This  peper  addresses  the  problem  of  estimating 
the  state  and  providing  a  measure  of  the  quality  of 
the  solution  for  a  source  confined  to  a  well- 
defined  region  of  the  state  space.  A  multlple- 
parameter  constrained  catiamtor  is  presented  for 
(1)  enhancing  the  quality  of  estimates  when  a  priori 
information  constrains  tha  state  to  a  known  (slnply- 
eonnected)  region,  and  (2)  determining  the  most 
probable  solution  when  the  regions  are  distinct 
(multiply-connected) . 


k\ 


When  the  source  is  known  to  be  confined  to  a 
simply-connected  region,  it  is  possible  to 
capitalize  on  such  information  via  multiple- 
parameter  constrained  estimation.  This  is  realized 
through  augmentation  of  the  Information  matrix  by 
satisfying  the  Kuhn-Tucker  conditions3  or  by 
treating  the  constraints  as  pseudo-measurements. 
Convergence  is  guaranteed  by  adaptively  adjusting 
the  weights  of  the  constrained  parameters. 


When  the  source  is  known  only  to  be  confined  la 
one  of  several  possible  well-defined  finite 
regions,  a  parallel  configuration  with  multiple 
constraints  is  presented.  The  configuration 
utilizes  both  dynamic  and  residual  clues  to 
classify  the  solution  as  to  its  most  probable  state 
space.  The  dynamic  clue  or  classifier  is  defined 
in  terms  of  a  measure  of  deviation  of  the  estimated 
velocity  parameters  from  its  expected  range  of 
values.  Residuals  are  exploited  by  determination 
of  expected  variance  and  whiteness  measures. 


Under  the  above  implesmntatlon,  the  ability  to 
provide  the  most  probable  estimate  of  the  state,  or 
solution  enhencesmnt  and  a  measure  of  solution 
quality,  is  dependent  upon  the  amount  of  a  priori 
information  available.  Experimental  results 
demonstrating  system  performance  for  various  cases 
outlined  above  are  presented. 


II.  UNCONSTRAINED  ESTIMATION 


The  problem  under  consideration  Involves  the 
estimation  of  the  position  and  velocity  of  a  con¬ 
stant  velocity  acoustic  source  from  noise-corrupted 
measurasMnts.  The  source-observer  scenario  is  illus¬ 


trated  in  figure  1.  Let  (rxl,  r„T)  and  (rx0.  ry0) 
be  the  positional  components  of  the  source  and 
receiver,  respectively.  The  discretized  version  of 
tha  dynamic  process  is  given  in  Table  1.  for  tha 
beerings-only  ease,  the  measurement  is  given  by 


z(k)w8<k) 


.ta^Ur^ki-r^ikll/tr^kl-r^fk)]} 


(1) 


which  represents  a  nonlinear  model  relating  the 
noise-free  smasurements  to  the  unknown  souree 


state.  In  (T-6),  ij  is  the  estimated  state  at 


the  selected  reference  time.  Its  value  at  any 
other  t Ism  Is  determined  via  (T-l)  and  used  in  (1) 
to  produce  the  appropriate  bearing  angle. 


Jmimimim  I—  ■  ■ . .  i  i  i 


Whan  the  number  of  naeaureswnts ,  K.  ii  graatar 
than  «,  < T— 6 )  rapraaantf  an  ovardatarmlnad  systaa 
of  nonlinear  aquation*.  A  weighted  laast-squaras 
approach  ainiaixaa  tha  non*  of  tha  rati dual  vactor 


*a»S  .  <2> 

whara  S-OlagCo0kl,  op  ia  tha  baarlog  aaesuraaaat 
ooi*a  (tandard  deviation.  and  Z(iy>  in  tha  boar lag 
■aquanca  ganaratad  by  tha  estiaatad  stata I  iy,  via 
(T-l).  (T-4).  and  (1).  Tha  problaa  l*  eoaplieatad 
by  tha  unuiual  obiarvability  propartiaa  of  thin 
lyataa,*  aipacially  for  long  rang*  acaoario*. 


Equation  (11)  rapraiant*  tha  aolution  for  tb* 
unconi trained  aazlaua  likelihood  aatiaator. 
Parforaanca  of  tha  aatiaator  haa  bean  aliened  by 
aiaaination  of  tha  ideal  information  aatrix,  or 
Craaer-Reo  bound,  for  large  rang*-to-baa*lin* 
geometries.1  In  thia  altuation,  tha  aaauaptloaa 
of  conatant  rang*  and  ayaaatric  gaoaatry  ar* 
valid.  Under  than  condition*,  tha  eigenvalue*  of 
tha  ideal  Information  arntrix  ar*  given  la  the 
aecond  column  of  Tabla  l.1  Hot*  that  aignificant 
deterioration  la  parformaac*  occur*  with  lncraaaiag 
rang*  or  no la*  laval. 


The  ainiaua  of  tha  norm- aquar ad  error, 

3  -  [li-l(iI)lV*iJ#-l(ii)l  .  (3) 

la  found  whan  the  aatiaat*  iy  cauaaa  tha  gradient 
G(xy)-dJ/3xy  to  vaniah;  l.a. . 

-l/2G(*T)-CJZ(iI)/aiTiTs'l(Z|t-Z(iT)l-C01.  (A) 

For  Gauaaian  noiaa,  tha  raaultlng  iy  rapraaanta 
the  maximum  likelihood  aatiaator  (HLI) .  Tha 
preanilti plying  matrix  la  given  by 

iaz(iT)/aitl»*_ls“lA(iT>  (i) 


glncn  error*  la  tha  aatiaataa  of  rang*  and  rang* 
rat*  ar*  iavaraaly  proportional  to  and 
raapactivaly,  it  la  aaaa  from  Table  2  that 
varlatioaa  la  thaa*  aatiaataa  algaif leantly 
lncraaa*  for  large  value*  of  "affective  noiaa, "  rog/B, 
whara  1  denote*  apathetic  baaalin*.  Whan  unraaaon- 
abla  aatiaataa  ranult,  4  priori  information  or 
hauriatic  data  can  b*  utllixad  to  advantage.  Often, 
known  parnaatara  or  kaowladg*  of  the  phyaical  con¬ 
straint*  on  aom*  functions  of  the  stata  component! 
ar*  available  and  should  b*  exploited.  Under  thaa* 
conditions,  tha  problaa  than  becomes  on*  of 
ainialzing  the  coat  function 

J-lZ.-Z(iy>lIS“2IZ1,-Z(xy> •  •  <12> 


R  1  -  Diaglr  2(k)i,  k-l,2,.  ...E 

eo*81  -ainfl^  t^conP^  -t^infl^ 
co*02  -ainBj  It^eoaBj  -2tfalne2 


A(X.j)« 


t(to.tR)  (I) 


[co*eK  KV0,BK  'Kta,inBzJ 

and  where  t,  1*  the  data  saapllng  period  and  «(t0,tK> 
ia  tha  transition  aatrix  between  the  initial  tlaa,  tq 
and  rafaranc*  time,  tg.  The  ktb  alaaant  of  the 
diagonal  aatrix  of  (6), 

r(k).{|fjIlk)-ri0(k)lJ*(?yTU)-fj0(k)lV/!  <»> 
is  tha  astiaatad  rang*  at  the  fclb  instant,  and 

8k-tan"lUrtT(k>-ri0(k>  1/ (c^ikl-c^k)  I }  (9) 

in  (7)  la  the  corraspoadlng  bearing  aatiaat*.  Hence, 
on*  seeks  to  solva  tha  noli  near  sat  of  aquations 

AT(xT)rls'2(ZB-Z(xT))-t01  (10) 

for  iy.  Employing  tha  Gauss-Hawton  iterative 
method5  to  solve  (10)  yields 

xj+i.VVAfrvvx^-\  •  <U) 

whara  Aj  and  Z(  ar*  evaluated  at  xj ,  and  tha 
step  alt*.  <j.  is  salactad  at  each  iteration  to 
ensure  convergence. 


subject  to  tha  constraint 

f(xT)Sb  .  <13> 

Hare,  tlxy)  and  b  denote  tb*  vector*  . . . . *M),T 

and  ((by.bj . b*)|*,  raapactivaly,  and  H  i*  tha 

nuabar  of  constraints.  Denoting  fi'iHHixyH*,  tha 
necessary  and  sufficient  conditions  for  J  to  b*  aini¬ 
aua  is  given  by  tha  Kuhn-Tueker  conditions.2'3  That  is. 


v.-vVWs  ■ 


Pi[bl”fl(ijel)1*0 

nio 

2i(ijel>Sbl 


1-1,2 . H  (lab) 

1-1,2 . H  (14c) 

1-1,2 . M  ,  (14d> 


where  et.l-1,2, . . . ,M  is  a  scalar  to  b*  determined. 
For  tb*  aittgl*  paraaatar  constraint  ease,  a  can  ba 
shown  to  be  conveniently  computed  itaratlvaly2  via 

Pj+l«PjedP  <15> 


4p»0 . 5 { l f  ( Xy > -b i /  IV1***! )  • 

{f (xT)/(f (xy)*d|f (*y)-b| I)  . 

and  whara  W  is  the  state  vactor  associated  with 
f(2y>,  Py  is  its  covariance,  and  d  is  salactad 
to  ensure  system  stability.  Hultipl*  paraaatar 


wi; 


vli 
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constraints  can  b«  realized  by  either  sequential  oc 
simultaneous  processing  via  (14).  For  the  case  of 
single  parameter  constraint,  experiments  have  shown 
satisfactory  convergence  and  stability  for  both 
speed  and  depth  constraint^ • $ .  For  the  case  of 
speed  constraint,  an  improvement  factor  of  2  in 
localization  error  has  been  demonstrated. 

An  alternative  implementation  of  estimation  in 
a  constrained  state  space  is  to  consider  the 
constraints  as  "pseudo-measurements . "  If  the 
measurement  vector  is  given  by 

Zp.fZfli.blT.n  .  <U> 

the  cost  function  then  becomes  JpaJ+J^  where 

Jh.(b-f<iT)lTp-2tb-f(*Tl.  (18) 

subject  to  the  constraints  of  (13).  The  solution 
is  obtained  by  finding  an  if  such  that  Jp  is 
minimized.  Setting  the  gradient  3Jp/3Xf  equal 
to  zero  and  employing  the  Gauss-Newton  iterative 
method  yields 

x  .  »i..4  .  ( ( ATr72S*2A.  rl*Trlr2z 

J*1  J  J  J  J  J  J  • 

♦  i  [*bi'Ai''l^i'I2,bi-f<Vn  •  <l” 

1*1 


^I’YV^j'V^kV  <20) 

where  Q  is  the  modified  information  matrix  given  by 


•»  .j*  -  2  -2  *  *T  n  » 

a.A  R  s  A  ♦  £  Abi^2*bi 


Ab;4f(sT>'3*T  .  (2?) 

Q ’Di »g  | , p  j  ] ,  (23) 

Zpe’(Ze  tb-f(5T»  1T)T  '  (2*> 

and  where  pj>0  and  is  either  known  or  can  be 
determined  adaptively  via 

p^-Pg./j  j-1.2...  <2>> 

until  the  constraints  are  satisfied.  Experiments 
conducted  utilizing  (20)  for  the  speed  constraint 
have  yielded  equivalent  results  to  those  obtained 
via  (1*).  Although  the  use  of  (14)  for  range 
constraint  under  adverse  conditions  has  experienced 
soaie  cases  of  slow  rate  of  convergence,  (20)  hat 
provided  stable  and  rapid  solutions.  Note,  however, 
that  (20)  represents  the  solution  of  an  unbiased 
estimator)  as  such  the  awdified  information  matrix 
(or  its  inverse)  mutt  be  interpreted  appropriately 
consistent  with  the  a  priori  data  description, 
when  insufficient  description  on  the  data-weightlng 
assignment  is  available,  the  modified  information 
matrix  can  be  more  appropriately  generated  by 
applying  (14),  or -in  the  ease  of  slow  convergence 
by  utilizing  the  speed  solution  of  (20)  as  the 


constrained  parameter  and  then  applying  (14). 
Further  comparison  of  (14)  and  (20)  in  regard  to 
their  robustness,  and  analysis  of  the  mechanisms 
that  impact  the  estimate  will  be  addressed  in 
future  studies. 

IV.  CONSTRAINED  ESTIMATION  IN 
SIMPLY -CONNECTED  REGIONS 

When  a  priori  information  constrains  the  source 
to  a  known  region  (simply-connected),  performance 
can  be  significantly  improved.  This  can  be  demon¬ 
strated  by  examining  the  augmented  information 
matrix  of  (21)  when  range  information,  with 
standard  deviation,  oa,  is  available  at  K . 

Under  this  condition, 

•T--2  -2-  -T  -2- 

aitJd  !  S  A  ♦  A„o„  A_  (26) 


♦<t0.tB)  (2?) 


|eot|JK  cos0R  KtfsinPK  Kt^cosP^J  • 

Assuming  uniform  signal-to-noise  ratio,  the  augmented 
information  matrix  at  K/2  becomes 


E/2  Qk  (k*K/2,ak  ]  ' 

(k-K/2)^  (k-K/2)2Qk  ( 


(K/2)8„  (K/2)  S2, 


-sinP^cosP^ 


-sinPkcosRk 


sinPKcosPK 


2  *  2* 

°g  *in®KC0,®E  e0*  ®K 


Using  the  assumption  of  symmetric  geometry,  0(K/2)  is 
diagonalized;^  that  is. 


,  2  2 
'  rk°3 


EIV  * 


For  long  range  scenarios,  the  range  is  assumed  to 
be  essentially  constant;  i.e.,  «*rl-  Under  these 
conditions,  the  expected  eigenvalues  of  Q(E/2) 
are  given  in  Table  2.  The  variance  is  given  by  the 
reciprocal  of  the  eigenvalue,  or 

2  2 
a  (0)o  (It) 

.  u  u  .  . 


e2( 0) «o2 ( R) 

M  U 


"’*^.*1).  J.,  41 


j'  *  *J*^  ■ 


where  oj(p)  is  the  variance  of  u  due  to  the 
parameter  p  alone.  Clearly,  if  range  information  is 
given,  the  expected  improvement  factor  in  the  reduc¬ 
tion  of  variance  over  bearings-only  processing  is 
(ojj(3>*o2(R)  i/oJfS) .  Equation  (33)  can  be 
generalized  when  multiple  parameters  are  known 
a  priori  and  Q(K/2)  is  diagonalizable  to  yield 


2 

a  * 
w 


«2<e> 

V 

i  ♦«2(0>E<r2(p1) 

U  ,  V  1 


(34) 


resulting  in  an  improvement  factor  of 
[l»og(R)Eio-2(pi> 1 .  Further  analysis  on  the  impact 
of  additional  information  is  contained  in  reference  7. 


V.  PROPERTIES  OF  ESTIMATION  IN 
CONSTRAINED  STATE  SPACE 

Based  on  the  analysis  in  the  previous  section, 
the  availability  of  a  priori  information,  heuristic 
or  otherwise,  can  clearly  provide  improvement  in 
system  performance.  However,  in  many  situations, 
such  as  the  one  in  which  the  source  is  known  only 
to  be  confined  to  one  of  several  distinct  regions 
(multiply-connected),  only  limited  heuristic 
information  is  available.  Under  these  conditions, 
improvement  in  state  estimation  is  still  possible 
by  providing  the  most  probable  solution. 

Consider  the  relation  for  cross-range-rate 
component 

R@>STsin(CT-B)-S0sin(C0-8)  <351 

where  8  is  the  bearing  rate,  ST  and  S0  are 
source  and  observer  speed,  respectively,  and  Cy 
and  r,  represent  source. and  observer  course, 
respectively.  Let  (Sy,Cy,5,(3)  be  the 
estimate  obtained  by  constraining  the  range  at 
Rc.  The  variation  of  speed  as  a  function  of 
range  can  be  analyzed  by  perturbing  (33)  to  yield 

hS/aR=(R*Rc4B/ORc)/sin0-(aa/flRcJ (<ST*4S)/tan0I  (36) 

where  9=Cy-3  and  the  assumption  is  made  that 
afl/aftc=0.  Generally,  0(R)  is  point  symmetrical  about 
(R,0>  and  can  be  approximated  as  piecewise  linear 
(Figure  2).  The  quantity  40/4 can  bn  treated 
as  a  constant,  ky,  within  the  interval  <Ri.*2>- 
Therefore,  the  slope  of  the  speed-range  function  can 
be  rewritten  as 

AS/ AR^v  ( ( 1J4  R^aft/hR^  )-k^S^cos0)/(si  n0*  40COS0)  .  (3  7) 

Clearly,  0  is  geometry  and  noise  dependent  and  is 
inversely  related  to  the  slope.  As  0  increases, 
the  change  in  the  speed  estimate  is  less  senstive 
to  range.  The  minimum  speed  can  be  computed  about 
(R,0)  by  setting  (31)  to  zero  to  yield 


Thus,  (3?)  and  (38)  provide  the  expected  dynamic 
behavior  of  source  estimates.  This  is  illustrated 
in  Figure  3.  The  solution,  dependent  on  the  noise 
conditions,  may  fall  anywhere  along  the  speed-range 
curve.  However,  if  the  maxium  speed,  Smtx,  is 
known  a  priori .  the  most  probable  solution  must 
then  be  bounded  by  Sm4X  and  Smjn  and.  therefore, 
is  confined  to  ft  as  shown  in  Figure  4.  If,  in 
addition,  the  source  is  known  to  be  in  either 
or  R?,  knowledge  of  S^j  then  can  eliminate 
/?2  as  a  possible  solution. 

Further  insight  can  be  gained  by  analyzing  the 
effects  of  constraining  the  estimates  away  from  the 
speed-range  function.  This  corresponds  to 
performing  estimation  with  range  and  speed 
constraints.  Thus,  given  the  estimate  (Sy.R), 
and  if  the  parameters  are  constrained  to 
(Sy,&*4R),  (33)  then  becomes 

(R*4R)  (3*413)  =STsin(0*4O)-Sosin(  Y*4y)  , 

(39) 

where  y*Cq-|S.  Assuming  small  40  and  4Y.  the  result¬ 
ing  bearing  rate  error,  4 8,  can  be  approximated  as 

4B=i(ST/R)4C(l-6C/2)cos0-  (4BR/R«|3AR/R>  )/( W4R/R)  ,  (40) 

where  6C  is  the  change  in  fiy  corresponding  to  AR. 

Equation  (40)  represents  the  slope  of  the 
residual,  and  can  easily  be  computed  for  each  leg 
of  constant  observer  velocity.  Furthermore,  it 
provides  a  measure  of  inconsistency  and  sensitivity 
in  the  state  estimates.  Such  a  measure  can  be  used 
in  conjunction  with  the  expected  residual  variance, 
as  given  by  (3),  to  supply  a  more  extensive  descrip¬ 
tion  of  the  residuals.  To  a  certain  extent,  (3) 
and  (40)  provide  a  "whiteness"  measure.  This 
measure  can  alternatively  be  obtained  by  performing 
a  spectral  analysis  on  the  residuals.  Similar 
analysis  can  be  performed  for  different  constraint 
combinations  or  with  additional  constraints. 


Thus,  when  a  priori  information  constrains  the 
source  to  one  of  several  possible  solution  regions, 
or  when  limited  heuristic  data  are  available,  the 
estimation  configuration  of  Figure  3  can  be  employed 
along  with  (37),  (38),  (3),  and  (40)  to  provide  the 
most  probable  solution. 


VI.  GENERAL  OBSERVATIONS. 
SOLUTION  QUALITY.  AND  SELECTION 


The  analysis  presented  up  to  this  point  deals 
with  the  problem  of  estimating  the  state  parameters 
by  capitalizing  on  any  available  a  priori 
information.  Depending  on  geometry  and  amount  of 
information  (heuristic  or  otherwise),  constrained 
estimation  can  provide  enhancement  in  the  target 
state  estimates  either  by  reducing  the  state  error 
variances  or  by  providing  the  most  probable 
solution(s).  Some  general  observations  are 
summarized  as  follows: 


*  m  A  «  m  • 

SBlifl;(ii*Rc4ft/6Rc)/k2eos0  (38) 

where  k;  is  generally  large  for  small  0. 
Consequently,  geometries  with  small  0  generally 
have  smaller  Smin.- 


1.  The  speed-range  relation  of  Figure  2  is 
derived  by  minimizing  the  cost  function,  J,  and  is 
geometry  dependent.  The  slope  and  minimum  speed 
are  predictable  and  can  be  analyzed  via  (37)  and 
(38).  For  geometries  that  exhibit  stronger  across- 
the-line-of-sight  component,  the  magnitude  of  the 


k 


speed-range  slop*  is  smaller  and  the  mininun  spetd 
is  larger;  furthsrnors,  the  residuals  are  nore 
sensitive  to  deviations  fron  the  solution  curve. 

7.  The  availability  of  valid  g  priori 
information  (e.g.,  range,  speed,  course)  will 
provide  enhanced  estinates  with  reduced  state  error 
variance,  consistent  with  respect  to  both  dynamic 
and  residual  behaviors. 

1.  The  availability  of  valid  speed  or  range 
information  will  enable  the  selection  or 
determination  of  the  most  probable  solution  based 
on  dynamic  and  residual  consistency  tests. 

4.  The  dynamic  behavior  curve  can  potentially 
be  applied  to  determine  the  approsinate  dynamic 
behavior  of  the  process. 

5.  In  the  absence  of  other  information,  the 
physical  constraint  of  nasimun  allowable  speed  and 
the  predicted  minimum  speed  can  be  employed  to 
bound  the  solution  heuristically.  In  addition, 
both  dynamic  and  residual  clues  can  be  employed  to 
determine  a  solution  region. 

Based  on  the  preceding  observations,  estimation 
via  the  constrained  approach  provides  inprovesMnts 
in  system  performance.  Given  a  state  estiaMte  from 
an  algorithm,  the  dynamic  and  residual  clues 
can  provide  a  check  on  its  validity.  In  addltioo, 
the  constrained  estimation  approach  provides  the 
mechanisms  that  masimize  the  use  of  any  available  a 
priori  information.  Furthermore,  it  can  be  employed 
for  solution  selection. 

Theoretically,  the  covariance  matrix  provides  a 
statistical  measure  of  solution  quality  assessment, 
although  its  validity  is  algorithm  dependent.  The 
predictable  dynamic  and  residual  behaviors  and 
solution  bounds  provided  by  constrained  estimation 
clearly  can  be  used  as  heuristic  solution  quality 
measures;  and,  when  used  in  conjunction  with  the 
covariance  matrix,  can  provide  a  viable  means  for 
solution  quality  assessment  and  solution  selection. 

VII.  SIMULATION  RESULTS  AMD  DISCUSSION 

Experiments  were  conducted  using  the  geosMtries 
of  Figure  1.  A  total  of  six  geometries  were 
considered.  A  normalized  observer  speed  <S0/Sn,x> 
of  0.47  was  employed.  Source  dynamics  are  given  in 
Table  3.  Zero  mean  Gaussian  noise  with  2*  standard 
deviation  was  added  to  the  true  bearing.  A  total 
of  400  equispaced  measurements  were  collected  on 
each  leg.  All  subsequent  discussion  is  referenced 
to  the  final  time. 

Figures  6  and  7  show  the  behavior  of  speed  and 
course  estimates  as  a  function  of  the  constrained 
range  for  different  9«Cj-3.  The  unconstrained  MLI 
estimates  are  also  included  for  completeness-  As 
shown,  the  dynamic  behavior  it  geometry  dependent. 

At  the  center  portion  of  the  course-range  plot,  the 
magnitude  of  the  slope  Increases  at  the  angle  0 
decreases.  Consequently,  the  geometry  with  the 
smallest  9  exhibits  the  smallest  minimum  speed, 
as  shown  in  Figure  6  (see  (38));  also,  the  speed- 
range  slope  is  much  sharper  with  smaller  9 
geometry  since  it  varies  inversely  with  sin9  and 


cos9  (see  (37)).  For  the  approximately  symmetric 
source-observer  geometries  considered,  the 
estimated  course  function  is  approximately  point 
symmetric  about  the  point  at  R^lSm^n(9)l  where 
£•^•90*.  In  the  ease  where  9  is  near  zero,  the 
180*  difference  in  the  estimated  course  correspond¬ 
ing  to  ranges  on  either  side  of  E^(Sm^n(9)J 
is  reflected  by  a  twitch  of  sign  for  the  slope  of 
the  speed-range  curve.  As  9  increases,  the  last 
term  of  (37)  dominates;  thus,  the  symmetric  change 
of  the  estimated  course  about  90*  in  Figure  7  leads 
to  slopes  for  the  speed-range  plot  which  are  equal 
in  magnitude  but  opposite  in  sign.  This  dynamic 
behavior  is  Illustrated  in  Figure  8  where  a  total 
of  30  noise  sequences  have  been  applied. 

Sensitivity  of  the  state  estimates  is  examined 
by  perturbing  the  range  or  speed  estimate  and  by 
monitoring  the  resulting  residuals.  The  results 
are  shown  in  Figures  9  and  10.  The  shaded  area  of 
Figure  9  represents  solutions  which  yield  approxi¬ 
mately  the  tame  value  of  residual  variance,  ijj1. 

In  essence,  this  area  can  be  viewed  as  a  region  of 
minimal  ;  therefore,  estimates  located 
outside  the  shaded  region  may  yield  residuals  which 
are  statistically  Inconsistent  and  which  should  be 
rejected  at  possible  solutions.  This  situation  is 
illustrated  in  Figure  10  when  constraints  were 
imposed  by  utilizing  an  Incompatible  range-speed 
coaAination.  In  fact,  the  residuals  have  the 
functional  form  et-**io*d9lTt*9el-  where  Tj  denotes 
the  length  of  the  l1™  leg,  ei0  is  the  referenced 
initial  residual,  and  9.1  1»  the  random  component. 

For  the  noise  free  ease,  the  slope  APi  agrees  well 
with  that  given  by  (40).  Thus,  if  incompatible 
a  priori  information  is  employed,  clues  from  the 
residuals,  such  as  eg*  and  •  c*n  potentially 
be  utilized  to  reject  any  invalid  estimate.  In  this 
context,  both  dynamic  and  residual  clues  can  be  ap¬ 
plied  advantageously  for  solution  quality  assessment. 

The  improvement  obtainable  when  good  information 
is  utilized  for  constrained  estimation  is 
illustrated  in  Figure  11.  In  this  figure,  it  can 
bn  seen  that  when  the  range,  Rc±0g,  or  speed 
is  given  as  heuristic  data,  the  constrained 
estimator  provides  significant  improvement  in 
solution  accuracy  and  solution  uncertainty 
reduction.  Solution  consistency  is  confirmed  by 
both  the  dynamic  behavior  and  the  residuals. 

Estimation  for  the  situation  when  the  source  is 
known  to  be  in  one  of  three  regions  is  demonstrated 
in  Figures  12  and  13.  Information  is  also 
available  (with  probability  1)  in  regard  to  the 
source's  maximum  speed.  The  configuration  of 
Figure  3  is  employed  by  constraining  range  to  each 
respective  region  with  and  without  the  additional 
speed  constraint.  For  the  ease  of  constraining 
only  range,  hypothesis  testing  of  maximum  speed  is 
employed,  and  the  results  show  that  the  region, 
denoted  by  //^,  is  the  true  solution.  For  the 
ease  of  constraining  both  range  and  speed,  the 
residual  clues  of  Figures  13a-c  again  provide  the 
necessary  information  to  select  R^  at  the  most 
probable  solution. 
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VIII.  SUMMARY  AMP  CONCLUSION 

The  problem  of  parameter  estimation  in  a 
constrained  state  space  that  capitalizes  on  the 
utilization  of  a  priori  information  (or  heuristic 
data)  was  presented.  A  nonlinear  estimator  with 
multiple  constraints  was  considared  and  its 
properties  analyzed.  The  estimator  is  a  batch 
processor  that  yields  both  dynamic  and  residual 
characteristics  which  permit  solution  enhanceaMnt, 
solution  selection,  and  quality  assassswnt. 
Sensitivity  of  these  characteristics  is  shown  to 
depend  on  source -observer  geometry.  Dynamic  clues 
are  cossaon  for  low  bearing  rate  trajectories,  while 
residual  clues  are  most  evident  in  scenarios  having 
a  noticeable  across-the-llne-of-sight  velocity 
component.  While  the  ability  to  determine  the  state 
parasMters  via  acoustic  swasurament  processing 
becosMS  increasingly  difficult  with  deteriorating 
conditions,  effective  utilization  of  a  priori 
information  is  shown  to  provide  significant 
enchancement,  when  the  source  is  known  to  be 
confined  in  a  well-defined  region,  enhancement  is 
realized  by  reducing  the  solution  error  variance. 
When  the  a  priori  information  or  heuristic  data 
constrain  the  source  in  one  of  several  regions,  the 
estimator  is  capable  of  providing  the  snst  probable 
solution.  In  addition,  both  dynamic  and  residual 
clues  are  predictable.  These,  when  used  in 
conjunction  with  the  estimated  state  covariance 
matriz,  can  provide  a  viable  measure  of  solution 
quality. 


Table  1.  System  Dynamics  and  Measurements 
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Table  2.  Eigenvalues  of  SJ(K/2)  via  Processing  Bearing 
(with  Range  Constraint) 
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